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ABSTBACT 


This  thesis  proposes  and  develops  two  microprocessor 
controlled  ultrasonic  systems  which  provide  absolute 
coordinate  reference  for  an  autonomous  sentry  robot  an  3  a 
robotic  manipulator.  These  systems  close  the  position 
control  loop  which  has  never  been  fully  closed  in  robotics 
and  provide  a  better  "testbed”  for  testing  path  planning  and 
manipulator  arm  trajectory  control. 

Each  system  involves  known  points  of  reference  and 
ranges  to  these  points  which  are  determined  by  timing  the 
interval  of  propagation  of  the  ultrasonic  transmissions. 
With  this  data,  a  microprocessor  calculates  the  positions  in 
cartesian  coordinates. 


TABLE  OF  CONTENTS 


I.  INTRODUCTION  .  7 

II.  THEORY  AND  DESIGN . 11 

III.  HARDWARE  FOR  THE  SENTRY  FOBOT’S  POSITIONING 

SYSTEM . 21 

IV.  SOFTWARE  FOR  THE  SENTRY  ROBOT’S  POSITIONING 

SYSTEM . 34 

V.  SENTRY  COORDINATE  SYSTEM  TEST  RESULTS  .  40 

VI.  HARDWARE  FOR  THE  MANIPULATOR  REFERENCE  SYSTEM  .  .  48 

VII.  SOFTWARE  FOR  THE  MANIPULATOR  REFERENCE  SYSTEM  .  .  51 

VIII.  MANIPULATOR  COORDINATE  SYSTEM  TEST  RESULTS  ....  54 

IX.  CONCLUSIONS . 58 

X.  RECOMMENDATIONS . 61 

APPENDIX  A:  DERIVATION  OF  SENIRY  POSITION  EQUATIONS  .  .  66 

APPENDIX  B:  PROTECTION  CIRCUITRY  FOR  THE  PRO-LOG  STD 

7000  .  68 

APPENDIX  C:  SENTRY  ROBOT  REFERENCE  SYSTEM  SOFTWARE  ...  70 

APPENDIX  D:  MANIPULATOR  REFERENCE  SYSTEM  SOFTWARE  ...  84 

APPENDIX  E:  MASTER  WIRING  DIAGRAMS  .  91 

LIST  OF  REFERENCES . 94 

BIBLIOGRAPHY  .  95 


INITIAL  DISTRIBUTION  LIS 


£ 


LIST  OP  TABLES 


I  Transmitter  Control  Codes  .  26 

II  Sample  Position  Coordinates  .  42 

III  Sample  Position  Coordinates  (cont*d) . 43 

IV  Port  Assignments  for  the  Manipulator . 50 

V  Receiver  Control  Codes  .  ....53 

VI  Sample  Position  Coordinates  (Manipulator)  ....  56 

VII  Sample  Positions  (Manipulator  cont’d)  .  57 


LIST  OP  FIGURES 


Typical  Room  with  Associated  Geometry . 12 

Sentry  Reference  System  Block  Diagram  .......15 

Typical  Manipulator  Ultrasonic  Reference  System  .  .  16 
Manipulator  Reference  System  Block  Diagram  ....  17 

Manipulator  Reference  System  Geometry  .  18 

RF  Transmitter  Schematic . 23 

Power  Switching  with  Reed  Relays . 24 

Low  Impedance  Switching  with  an  Analog  Switch  ...  25 

RF  Receiver  Schematic  . . 27 

LM311  Comparator  and  Interface  Circuitry  .  28 

LM1812  Schematic  .  ....30 

Polaroid  Ranging  Module  Schematic  .  32 

LM317,  LM340T-6.0,  and  LM723CN  Voltage 

Regulators . 33 

Flow  Diagram  of  Sentry  Reference  System  Logic  ...  35 
PL/I  -  Assembly  Language  Parameter  Passing  ....  39 

Testing  Room  Geometry  . 

LM311  and  Interface  Circuitry  (Manipulator)  .  . 

Flow  Diagram  of  the  Manipulator  System  Logic 


I.  INTRODUCTION 

As  the  automation  of  labor  continues,  mobile  robots 
which  can  accurately  navigate  within  their  environments  will 
become  more  important.  Although  these  robots  may  not 
realize  the  humanoid  forms  of  the  science  fiction  writer, 
their  design  will  entail  several  general  characteristics, 
foremost,  a  robot  has  a  central  controller  which  is  most 
commonly  a  microprocessor  or  a  network  of  microprocessors. 
Second,  the  robot  performs  a  task  or  multiple  tasks  which 
are  usually  too  repetitive  or  dangerous  for  their  human 
counterparts.  Finally,  the  controller  of  the  robot 
generally  controls  seme  type  cf  mechanical  motion.  This 
motion  includes  mechanical  manipulators  and  platform 
translation.  Admittedly,  these  characteristics  encompass 
many  systems  which  may  or  may  net  be  considered  robots,  but 
as  of  this  date,  there  is  no  accepted  definition  for  a 
robot. 

The  motivation  for  this  thesis  came  from  "A 
Microprocessor  Controlled  Autonomous  Sentry  Robot",  a  thesis 
by  Hobart  R.  Everett,  Lieutenant  Commander,  United  States 
Navy.  In  his  thesis,  LCDR  Everett  describes  his  first 
design  for  an  autonomous  sentry  robot.  LCDR.  Everett  also 
states  the  need  for  absolute  position  information  by  which 
the  robot  may  effectively  navigate  £  Ref .  1]. 

Currently,  automated  mobile  platforms  obtain  position 
information  from  accelerometers,  open-loop  dead  reckoning 
(DR)  schemes,  or  remote  control  guidance.  Each  of  these 
methods  is  unacceptable  to  the  sentry  robot  concept.  First, 
accelerometers  are  too  expensive.  The  sentry  robot  is 
ideally  an  expendable  resource  since  it  may  operate  in  a 
hostile  environment.  It  is  also  a  relatively  slow  device 


with  small  accelerations  which  require  extremely  sensitive 
accelerometers.  The  two  preceding  factors  force  the 
requisite  accelerometer  designs  to  be  cost  prohibitive. 
Secondly,  by  definition,  an  autonomous  sentry  robot  operates 
without  human  intervention.  This  requirement  eliminates  the 
numerous  remotely  controlled  systems.  Finally,  the  inherent 
errors  of  dead  reckoning  navigation  prohibit  its  use  as  a 
long-term  navigation  system. 

Even  with  the  most  accurate  DR  and  motion  detection 
devices,  position  errors  accrue  in  the  position  information 
due  to  measurement  errors.  Wheel  slippage,  turn  radius 
errors,  quantization  and  axle/potentiometer  interfaces 
reduce  the  effectiveness  of  DR  navigation.  Quantization  and 
sensitivity  limit  the  accelerometer  guidance.  Accidents  or 
power  interruptions,  which  involve  the  robot,  adversely 
affect  both  DR  and  accelerometer  navigation. 

The  solution  requires  the  designer  to  fully  close  the 
navigation/position  control  loop.  The  robot  requires  a 
means  by  which  it  can  independently  update  its  position 
information.  This  information  comes  from  an  external 
absolute  reference  system.  To  be  effective,  the  reference 
system  must  eliminate  or  reduce  the  errors  previously 
discussed  and  be  inexpensive.  In  addition,  the  design 
requires  low  power  consumption,  small  component  size,  and 
ease  of  implementation.  Finally,  if  the  update  process 
operates  quickly  enough,  the  need  for  DR  navigation  is 
virtually  eliminated. 

Armed  with  accurate  position  data,  the  sentry's 
reconnaissance  need  not  be  random  patterns  like  those 
generated  by  Everett's  "fiobart  I”.  An  effective  sentry 
transits  the  entire  threat  area  in  a  timely  and  efficient 
manner.  While  random  motion  statistically  ensures  one 
hundred  percent  coverage,  there  is  no  guarantee  of  coverage. 
A  robot,  with  a  memory  map  as  described  by  Bradley  Weinstein 


in  [Kef.  2],  can  guarantee  one  hundred  percent  coverage  by 
recording  its  past  visit  times  in  areas  and  using  these 
times  to  establish  interim  navigation  goals. 


While  the  reference  system  described  within  this  thesis 
is  for  a  sentry  robot,  many  of  these  navigation  concepts 
apply  to  other  robctic  platforms.  One  example  is  an 
automated  platform  for  battlefield  use.  The  United  States 
Army  has  interests  in  this  area.  A  second  vehicle  is  an 
autonomous  underwater  vehicle.  Obviously,  an  underwater 
vehicle  is  of  great  interest  to  the  United  States  Navy. 

The  control  of  robot  manipulators  is  closely  related  to 
the  autonomous  sentry  robot's  control  problem.  Although  the 
movements  of  the  manipulator  are  constrained  with  respect  to 
those  of  the  sentry,  the  placement  and  accuracy  of  the 
reference  system  is  far  more  critical  with  the  manipulators. 
However,  the  manipulator  controller,  at  present,  still  faces 
the  same  problem  of  closing  the  open-loop  of  the  positioning 
system. 

The  repeatability  of  current  manipulators  is  .05  inches 
but  the  absolute  accuracy  is  orly  .5  inches  [fief.  3],  Any 
improvement  in  accuracy  requires  better  machining  but  at  a 
significant  increase  in  cost.  Manipulators  have  gear  and 
I  wheel  slippage,  friction,  and  quantization  problems  just 

like  those  of  the  sentry  robot.  As  a  result,  the  designers 
must  include  tolerances  for  errors  or  a  human  operator  must 
reinitialize  the  manipulator  after  a  set  number  of 
|  movements.  In  order  to  more  fully  automate  these  processes 

and  improve  their  accuracy,  the  position  control  loop  needs 
to  be  closed  with  a  reference  system. 

This  thesis  explores  the  hardware  and  software  to 
develop  a  reference  system  for  both  the  sentry  robot  and  the 
robot  manipulator.  The  thesis  treats  the  sentry  robot 
problem  first  and  the  manipulator  problem  follows.  All  of 


the  research  involves  ultrasonic  sensors.  The  designs  use 
ultrasonic  sensors  because  of  their  cost  and  availability  to 
the  student,  and  considering  that  the  medium  is  air, 
ultrasonic  devices  are  a  a  logical  choice.  The  theory  of 
both  systems  resides  in  the  next  chapter.  Chapters  three 
through  eight  contain  the  hardware,  software,  and  test 
results,  respectively,  for  the  autonomous  sentry  robot 
reference  system.  Following  the  sentry  robot  design, 
chapters  six  through  eight  present  the  manipulator  design  in 
the  same  manner.  Finally,  chapters  nine  and  ten  summarize 
the  conclusions  and  recommendations.  The  appendices  contain 
complete  copies  of  the  software  which  were  developed  plus 
additional  information  which  is  referenced  in  later 
chapters. 


n 


The  general  design  for  both  the  sentry  robot  and  the 
manipulator  positioning  systems  uses  geometry  which  has  been 
used  in  nautical  navigation  fcr  many  years.  Given  only 
range  information  from  known  points  of  reference,  the 
mariner  plots  circles  of  equal  distance  centered  at  the 
reference  points.  The  intersection  of  the  lines  define  the 
mariner's  position.  Numerous  books  abound  which  discuss 
this  navigation  method.  This  thesis  will  not  discuss  these 
concepts  further  except  to  note  that  three  range  arcs  are 
required  to  ensure  an  unambiguous  position  or  fix  in  a  plane 
unless  other  information  is  available. 

The  sentry  robot's  reference  system  involves  two  or  more 
remote  ultrasonic  transmitters  at  known  locations.  When  a 
position  up-date  is  required,  the  robot  remotely  keys  the 
ultrasonic  transmitters  via  a  radio  frequency  link  and  meas¬ 
ures  the  time  of  propagation  cf  the  sound  waves  from  the 
remote  site  to  the  robot's  ultrasonic  receiver.  Knowing  the 
speed  of  sound  in  air,  the  robot  determines  the  distance  to 
the  remote  site  using  equation  2.1  . 


distance  =  velocity  *  (total  time  -  delays) 


(eqn  2.1} 


The  delays  will  be  discussed  later.  Figure  2. 1  shows  a 
typical  room  with  the  appropriate  geometry  plotted. 

A  robot  cannot  implement  this  procedure  graphically  but 
must  do  so  mathematically  via  a  microprocessor.  Appendix  A 
contains  a  detailed  derivation  cf  the  equations.  The  equa¬ 
tions  which  describe  the  coordinates  of  the  intersections 
between  two  range  arcs  reduce  tc  a  quadratic  of  the  form 


(X,0) 


A*x**2  +  B*x  +  C  =  0 


(egn  2.2) 


where 

A  =  4*  (OFl**2+OF2**2-2*OF1*OF2+DIF**2)  (egn  2.3) 

B  =  4*  (0F2**3  -  OF  1**3  +  (OF1-OF2)  *R1**2  (egn  2.4) 

+  OFl*OF2**2  ♦  (OF  2*OF  1**2  +  (R2**2)  *  (*OF1-OF2) 

-  (DIF**2)*(OF1+OF2)) 

C  =  E 1**4  +  R2**4  +  DIF**4  +  CF1**4  +  OF2**4  (egn  2.5) 

+  2*  (-  (E  1**2)  *  (OF  1**2)  +  (R1**2)  *  (OF2**2)  +  (E2**2)  *OF1**2 

-  (B1**2)  *{H2**2)  -  (E1**2)  *  (EIF**2)  -  (H2**2)  *DIF**2) 

-  (CF1**2)*0F2**2)  +  (DIF**2)  *OF1**2) 

♦  (DIF** 2)  *  (OF 2**  2)  -  (R2**2)  *  (OF2**2) 

Rl  =  range  to  site  cne  (egn  2.6) 

R2  =  range  to  site  two  (egn  2.7) 

OF  1  =  offset  from  reference  origin  to  site  (egn  2.8) 

one  on  the  axis  of  the  coordinate  being  sought 

0F2  =  offset  from  reference  origin  to  site  (egn  2.9) 

two  on  the  axis  of  the  coordinate  being  sought 

DIF  =  difference  in  the  offsets  of  the  two  (egn  2.  10) 
sites  on  the  axis  of  the  coordinate  not  being  sought 

By  solving  equation  2.2  for  all  known  solutions,  the 
robot  determines  its  position  by  comparing  the  solutions  of 
the  various  pairs  of  range-arcs,  comparing  the  solutions 
with  its  estimated  current  position,  or  by  using  various 
restrictions.  For  example,  this  design  permits  operation 


only  in  the  positive  quadrant  of  an  X-Y  grid  coordinate 
system.  Therefore,  the  program  discards  all  negative  solu¬ 
tions.  The  design  also  uses  feet  as  the  fundamental  unit 
although  any  dimensional  unit  will  work  as  long  as  all  of 
the  quantities  are  uniform. 

Figure  2.2  contains  a  block  diagram  of  the  system. 
Whenever  the  robot  requires  an  update  of  its  position,  the 
robot’s  master  microprocessor  or  a  slave  microprocessor 
which  may  be  dedicated  to  navigation  keys  the  appropriate 
ultrasonic  transmitter  by  correctly  emitting  the  corre¬ 
sponding  radio  transmission.  This  requires  the  micropro¬ 
cessor  to  interface  with  the  external  radio  transmitter. 
Simultaneously,  the  microprocessor  initiates  a  timer  which 
measures  the  time  of  propagation  of  the  sound  wave.  At  the 
remote  site,  a  radio  frequency  receiver  which  is  interfaced 
with  the  ultrasonic  transmitter  detects  the  appropriate 
radio  signal.  The  radio  receiver  triggers  the  ultrasonic 
transmitter.  An  ultrasonic  receiver  which  is  also  inter¬ 
faced  with  the  navigation  microprocessor  detects  the 
ultrasonic  signal  at  the  robot. 

All  of  the  necessary  hardware  components  are  readily 
available,  small,  and  inexpensive.  Most  importantly,  the 
components  which  are  located  cn  the  robot  are  low  power 
consumers  and  they  can  be  powered  down  when  not  in  use.  Low 
power  consumption  is  essential  to  a  truly  autonomous  robot 
since  its  power  supply  is  self-contained. 

While  the  sentry  robot’s  position  system  is  primarily  a 
two-dimensional  problem,  the  manipulator  control  problem  is 
three-dimensional.  Again,  the  solution  uses  range  informa¬ 
tion,  gecmetry,  and  ultrasonic  sensors  to  identify  the  posi¬ 
tion.  However,  the  system  does  not  require  a  radio 
frequency  link.  Instead,  the  controlling  microprocessor 
interfaces  directly  with  the  transmitting  and  receiving 
ultrasonic  sensors.  The  problem  reduces  to  an  interface  of 
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Figure  2.2  Sentry  Reference  System  Block  Diagram 


the  ultrasonic  components  and  a  software  package  for 
control.  Figure  2.3  shows  a  typical  system.  Figure  2.4 
contains  the  block  diagram  of  such  a  system. 

The  microprocessor  determines  the  manipulator’s  tip 
position  by  applying  the  law  of  cosines  to  the  range  infor¬ 
mation  obtained  from  the  sensors.  By  placing  three  sensors 
in  the  same  plane  in  an  "L"  formation,  the  problem  simpli¬ 
fies  and  takes  advantage  of  special  geometry.  Figure  2.5 
shows  the  geometry  of  the  system.  The  range  information  of 
any  two  sensors,  which  are  colocated  on  a  reference  axis, 
plus  their  respective  locations,  define  the  coordinate  of 
the  manipulator  on  the  axis.  Tte  two  range  vectors  form  two 
cones  which  share  a  common  base  when  the  vectors  are  rotated 


Figure  2.4  Manipulator  Reference  System  Block  Diagram 

about  the  common  axis.  The  intersection  of  the  cones'  base 
plane  and  the  reference  axis  defines  the  actual  coordinate 
position  of  the  manipulator. 

First,  with  the  given  range  information  and  the  law  of 
cosines,  the  microprocessor  computes  the  angle  of  departure 
of  the  range-vector  with  respect  to  the  common  axis  using 
equation  2.11 

Alpha  =  arcos((AR**2+BR**2-AB**2)/(2*AR*BR))  (egn  2.11) 


Alpha  =  angle  of  departure 


(eqn  2.  12) 


AB  =  distance  between  the  sensors 


(egn  2.  13) 


LPHA 


AS. 


JS(AI.PHA) 


AS  =  range  from  site  A  to  manipulator  tip  (egn  2.  14) 


BS  =  range  from  site  B  to  manipulator  tip  (egn  2.  15) 

Next,  the  microprocessor  determines  the  dot  product  of  the 
range-vector  and  the  respective  axis  using  eguation  2.16  . 


Dot  product  =  AR*cos (Alpha) 


(egn  2.  16) 


The  microprocessor  determines  the  actual  coordinate  by 
adding  the  dot  product  with  the  respective  site  offset  from 
the  system  origin. 

After  determining  the  sec  end  coordinate  in  the  above 
manner,  the  system  computes  the  last  coordinate  by  applying 
eguation  2.17  which  relates  a  vector's  magnitude  with  its 
respective  projections  onto  a  three  dimensional  coordinate 
system. 


Z  =  ( AH**2  -  X**2  -  Y**2) **. 5 


(egn  2.  17) 


X,Y,Z  =  the  respective  dot  products  of  the  (egn  2.19) 
range  vector  on  the  axes 

This  geometry  permits  the  sensors,  which  establish  the  coor¬ 
dinate  system,  to  lie  in  a  plane  outside  of  the  area  of 
movement  of  the  manipulator.  Also,  these  eguations  handle 
all  angles  from  zero  to  one-hundred  eighty  degrees  since  the 
cosine  function  is  single-valued  over  this  region. 

Neither  the  sentry  robot  nor  the  manipulator  designs 
focus  upon  a  particular  robot  design.  Instead,  the  author 
attempted  to  keep  the  designs  simple  and  transportable  so 
the  designs  could  be  interfaced  with  many  different  systems. 
Early  simulations  used  PL/I  on  the  Naval  Postgraduate 


School’s  IBM  3033  system.  The  actuax  test  design  involved 
Fl/I-80,  Z-80  assembly  language,  the  Pro-Log  STD  7000 
Development  Station  and  external  circuitry.  Programming 
occurred  on  an  Altos  computer  with  MP/M  II  wnich  contains  a 
PL/I-80  compiler,  Macro-80  compiler,  Link-80  for  module 
linkage,  and  Genhex  for  hex-code  generation.  As  stated 
earlier,  the  above  choices  do  net  reflect  a  design  decision, 
but  instead,  reflect  the  availability  of  resources. 
Finally,  the  programs  maximize  their  generality  by  having 
the  hardware  interface  routines  and  the  clock  routines  in 
separate  modules.  These  routines  which  are  specific  to  each 
implementation  may  be  changed  without  seriously  affecting 
the  main  computational  program. 

The  remainder  of  this  thesis  presents  the  details  of 
these  test  designs.  The  hardware  and  software  of  the  sentry 
robot's  reference  system  is  first.  The  details  of  the 
manipulator  reference  system  follow. 


III.  HABDWA8E  FOB  TBE  S2NTBY  EOBOTJ.S  POSITIONING  SYSTEM 

From  the  beginning  of  this  design,  the  utilization  of 
"off-the-shelf”  components  was  a  primary  goal.  By  using 
components  which  are  currently  available,  the  design  is  less 
costly  and  the  designer  spends  less  time  "re-inventing  the 
wheel".  Instead,  the  designer  faces  numerous  interface 
problems  between  the  various  components.  However,  these 
interface  problems,  as  a  rule,  are  not  as  complex  or 
difficult  as  designing  the  entire  system  from  scratch.  This 
concept  parallels  current  efforts  in  VLSI,  custom  chip  and 
VHSIC  designs  where  proven  general  designs  are  slightly 
altered  for  each  specific  use.  Each  new  design  is  merely  a 
collection  of  building  blocks  which  nave  been  previously 
designed,  tested,  and  implemented. 

The  microprocessor  interface  requires  five  logic  control 
lines  outbound  and  one  data  line  inbound.  While  these  lines 
could  be  directly  linked  to  the  external  circuitry  via  the 
data  bus  of  the  microprocessor,  this  is  not  a  safe  idea 
during  early  development  stages  when  many  changes  and/or 
accidents  may  occur.  Appendix  B  contains  an  eight  bit  I/O 
port  circuit  designed  by  David  Bigmaiden  of  the  Naval 
Postgraduate  School.  This  circuit  provides  protection  for 
the  microprocessor  and  an  addressable  input/output  port. 
The  design  uses  two  74138,  one  74273,  one  7432  and  one  74244 
chips.  The  circuit  includes  access  to  the  address  bus,  data 
bus,  and  the  respective  control  lines  such  as  read  and  write 
enable. 

The  radio  transmitter  and  receiver  sections  are 
available  at  Radio  Shack  (Catalogue  No.  277-  1012).  The 
remote  control  module  pair,  which  is  made  by  Archer,  operate 
at  27  MHz  and  provide  four  control  functions.  Pulse  code 


modulation  delineates  two  of  the  four  control  signals.  The 
other  two  control  signals  are  a  constant  carrier  signal  and 
the  absence  of  a  signal.  The  transmitter  requires  a  nine 
volt  DC  power  supply.  The  receiver  requires  both  a  three 
and  nine  volt  DC  power  supply.  [flef.  4] 

The  schematic  of  the  transmitter  is  in  Figure  3.1  The 
interface  problems  between  the  transmitter  and  the 
microprocessor  are  twc-fold.  First,  the  microprocessor  must 
control  three  nine  vclt  power  supply  lines.  Second,  the 
microprocessor  must  control  three  low  impedance  connections. 
Normally,  two  double-pole/double-throw  switches  provide  the 
requisite  control. 

For  the  power  switching,  the  design  uses  reed  relays 
from  Claire  and  Archer.  These  devices  are  TTL  compatible. 
Figure  3.2  shows  the  respective  wiring  diagrams.  Early 
designs  considered  the  use  of  N EH,  CMOS,  and  VMOS  devices, 
however  the  nine  volt  switching  consideration  always  forced 
the  control  voltage  levels  beyond  TTL  compatibility.  Thus, 
typical  microprocessor  control  was  not  possible  with  these 
devices. 

The  interface  circuit  for  the  low  impedance  lines  uses 
the  National  Semiconductor  CD4  066BM/CD4066BC  quad  bilateral 
switch  as  shown  in  Figure  3.3  .  This  analog  switch  is  TTL 
compatible  as  long  as  the  IC’s  power-supply,  Vdd,  remains  at 
TTL  levels.  If  the  chip’s  power  supply  exceeds  five  volts 
(maximum  allowable  voltage  is  fifteen  volts) ,  the  control 
voltages,  which  turn  the  switches  off  and  on,  must  also 
increase  beyond  TTL  levels.  This  fact  makes  these  switches 
unusable  for  the  power  switching  control  of  this  system. 

Armed  with  the  circuitry  of  Figures  3.2  and  3.3,  the 
microprocessor  keys  the  radio  transmitter  by  sending  the 
appropriate  code  to  the  I/O  port  at  address  "FF".  Table  I 
contains  the  respective  codes  and  their  consequences.  When 
all  connections  are  open,  nc  transmissions  exist.  A 
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Figure  3.3  Low  Impedance  Switching  with  an  Analog  Switch 
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combination  of  transmitter  connections  between  transmitter 
terminals  two  and  three  with  either  terminal  four  or  five 
powered  by  the  nine  volt  source  creates  the  respective  pulse 
code  modulation  from  the  transmitter.  The  connection  of 
transmitter  terminals  one  and  three  generates  the  constant 
27  MHz  carrier. 


TABLE  I 

Transmitter  Control  Codes 

00000........  All  connections  open* 

10001  .  Constant  carrier  generation 

1011C .  3000  hertz  pulse  code  modulation 

11010 .  500  hertz  pulse  code  modulation 

*  (The  most  significant  bit  is  the  left  bit.) 


The  receiver  schematic  diagram  is  in  Figure  3.4  The 
three  receivers  each  detect  the  complete  set  of  control 
signals.  The  receivers  have  three  power  sections  which  are 
normally  used  to  power  DC  servo  motors.  The  transistors 
which  control  these  pcwer  sections  are  marked  in  Figure  3.4 
When  the  appropriate  signal  is  present  or  absent,  the 
collectors  of  the  controlling  transistors  have  associated 
voltage  levels.  An  1M311  comparator  tests  these  levels  and 
appropriately  keys  the  ultrasonic  transmitter.  Figure  3.5 
shows  the  comparator  and  the  interface  circuitry  which  keys 
the  ultrasonic  transmitter. 

During  this  research,  the  author  considered  two 
different  ultrasonic  devices,  the  Polaroid  Ultrasonic 
Ranging  System  and  the  National  Semi-Conductor  LM1812 
Ultrasonic  Transceiver  Driver  with  the  Panasonic  EFP.-CTE40KZ 
Ceramic  Transducer.  The  Polaroid  device  is  an  excellent 
system  for  range  finding  during  obstacle  avoidance.  The 
half-power  bandwidth  is  narrow  at  ten  degree.-.  It  also  has 
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Figure  3.5  LM311  Comparator  and  Interface  Circuitry 


an  automatic  sensitivity  control  which  enables  the  device  to 
provide  reliable  data  out  to  thirty-five  feet  [Bef.  5]. 
Although  this  device  was  used  at  the  remote  sites  for  the 
system  test,  the  LM1812  is  a  better  choice  at  both  the 
remote  sites  and  at  the  robot  as  a  receiver.  The  Polaroid 
device  uses  an  electrostatic  transducer  which  must  be 
polarized  to  receive  correctly.  The  device  must  either 
transmit  or  have  a  150  volt  power  supply  in  parallel  with 
the  transducer  to  correctly  polarize  the  device  £Bef.  6]. 
In  a  receive  only  mode,  a  transnission  to  establish  this  150 
volt  differential  is  unacceptable  and  the  circuitry  which  is 
required  to  maintain  a  constant  150  volt  level  is  too  costly 
in  power  consumption.  The  Panasonic  transducers  are  ceramic 
devices  which  are  permanently  polarized.  Thus,  the  device 
is  passive  in  a  receive  only  mode. 

Alsc,  this  positioning  concept  requires  omni-directional 
transmission  and  reception.  Comparing  the  3-db  beam  width 
of  the  Polaroid  and  Panasonic  devices,  the  Panasonic 
transducers  need  far  fewer  transducers  operating  in 
parallel.  The  Panasonic  3-db  beam  width  is  sixty  degrees 
[Hef.  7],  Therefore,  the  receiver  needs  only  six  Panasonic 
devices  versus  thirty-six  of  the  Polaroid  design.  Each 
transmitter  site  needs  only  three  Panasonic  transducers  to 
provide  one-hundred  and  eighty  degrees  of  coverage  (if  the 
transmitter  is  placed  against  a  wall)  . 

Figure  3.6  contains  the  circuit  diagram  for  the  LM1812. 
The  diagram  contains  a  complete  design  which  will  both 
transmit  and  receive.  The  connections  marked  with  an 
asterisk  need  not  be  made  when  the  device  is  acting  only  as 
a  receiver. 

Figure  3.7  contains  the  circuit  diagram  for  the  Polaroid 
system.  Texas  Instruments  now  markets  an  improved  version 
of  the  Polaroid  Ranging  Module,  which  is  called  the  SN28327. 
The  SN28827  uses  two  Texas  Instrument  chips,  the  TL852  and 
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Figure,  3.6  LM1812  Schematic 


30 


TL851.  However,  this  unit  is  compatible  only  with  Polaroids 
electro-static  transducer  and  thus  the  lack  of  permanent 
polarization  remains. 

Finally,  three  separate  devices  provide  voltage 
regulation  for  the  circuitry.  All  nine-volt  sources  use  the 
1M317.  The  six-volt  sources  use  the  LM340T-6.Q  and  the 


three-vclt  sources  use  LM723C: 


The  different  current 


requirements  of  the  three  voltage  supplies  determined  the 
device  which  was  employed.  Figure  3.8  contains  the 
regulators  and  their  external  circuitry. 

As  stated  earlier,  the  microprocessor  interface  contains 
five  outbound  lines  and  one  input.  The  outbound  lines 
merely  act  as  switches  to  turn  the  respective  transmitters 
on  and  off  along  with  the  requisite  power  supply.  The  lone 
input  line  tells  the  microprocessor  whether  an  ultrasonic 
signal  is  present  at  the  receiver  or  not.  Therefore,  the 
entire  power  for  timing,  calculation,  and  distance 
determination  lies  within  the  software  portion  of  the  system 
which  is  discussed  in  the  next  chapter. 


LM340T-6.0 


17.  SOFTWARE  FOB  THE  S ENTRY  BOBOT«S  POSITIONING  SYSTEM 

The  structure  of  the  software  package  is  modular  so  that 
the  portability  of  the  package  is  increased.  The  package 
has  two  requirements  which  are  unique  to  each  microprocessor 
or  robot  design.  First,  the  system  needs  a  timing  function 
which  may  be  realized  in  a  hardware  or  software  clock. 
Second,  the  input/output  port  control  is  unique  to  each 
microprocessor  design.  Both  of  these  variable  segments 
reside  in  assembly  language  nodules  .  As  long  as  the 
appropriate  control  signals  reach  the  external  circuitry  and 
the  correct  propagation  times  return  to  the  main  program, 
the  major  portion  of  the  program  needs  no  change. 

Appendix  C  contains  a  listing  of  all  of  the  programs. 
Figure  4.1  contains  a  flow  diagram  of  the  basic  logic  of  the 
program.  The  main  program  initiates  the  majority  of  the 
system  variables  including  those  which  are  passed  between 
the  FI/I  language  programs  and  the  assembly  language 
programs.  Following  the  above  initialization,  the  PL/I 
program  calls  an  assembly  language  program  which  is  called 
INIT  to  initialize  the  Pro-Log  7804  Z80A  Processor 
Counter/Timer  Card  which  is  resident  in  the  STD  7000  work 
station.  This  hardware  clock  provides  the  requisite  timing 
function.  For  this  system,  the  clock  acts  as  a  down  counter 
which  counts  .0002  second  intervals.  Whenever  an  interval 
expires,  the  counter/timer  card  generates  an  interrupt.  The 
assembly  language  subroutine  CICCKSB  services  the  interrupt 
by  incrementing  and  storing  the  clock  count.  CLOCKSR  also 
checks  for  a  time-out  condition  and  sets  the  appropriate 
error  flag.  The  time-out  and  error  flag  will  be  discussed  in 
more  detail  later. 
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*  _  -  -  possible  Alternate  loops 


Figure  4.1  Flow  Diagraa  of  Sentry  Reference  Systea  Logic 


After  initializing  the  clock,  the  PL/I  program  serially 
keys  the  remote  transmitter  sites  7ia  the  assembly  language 
program  KEY.  This  is  the  only  parameter  passing  which 
occurs  between  two  different  types  of  language  routines  in 
this  system.  KEY  starts  the  clock  and  passes  the  code  to 
the  output  port  which  controls  the  radio  transmitter. 
Subsequently,  KEY  goes  into  a  loop  which  polls  the  input 
port  and  the  time-out  flag  for  a  change  of  status.  Once  a 
change  in  status  is  detected,  KEY  stores  the  data  and 
returns  control  to  the  PL/I  program. 

Between  each  measurement  cycle,  the  transducers  need 
debouncing  to  prevent  erroneous  signal  detection.  The  BAIT 
subroutine  provides  this  feature.  WAIT  tests  the  input  port 
for  the  presence  of  a  signal  and  upon  finding  no  signal,  it 
begins  a  decrementing  counting  loop  which  gives  the 
transducer  "ringing"  sufficient  time  to  die  out.  When  the 
count  reaches  zero,  WAIT  returns  control  to  the  PL/1 
program. 

Once  the  propagation  times  are  returned  to  the  PL/I 
program,  the  PL/I  subroutine  CONTIH  converts  the  time  of 
propagation  into  distance  using  equation  2.1  .  The 
remainder  of  the  PL/I  program  implements  the  solution  cf  the 
range-arc  intersection  problem  which  was  described 
previously.  Finally,  the  program  passes  the  desired 
information  to  the  CRT.  In  an  actual  robot,  other  programs 
or  microprocessors  would  use  this  information  for 
navigation. 

Four  features  cf  this  system  require  additional 
discussion.  First,  if  the  ultrasonic  receiver  fails  to 
detect  a  signal,  the  system  wculd  stall  indefinitely  while 
it  awaits  a  signal  detection  unless  a  provision  is  made  to 
cover  this  possibility.  The  time-out  flags  handle  this 
situation.  In  the  clock  service  routine,  the  pregram 
compares  the  current  value  of  the  clock  count  with  the  value 


which  equates  to  the  largest  dimension  of  the  room.  If  the 
clock  count  exceeds  this  value,  the  error  flag  is  set.  A 
propagation  time  larger  than  the  maximum  dimension  of  the 
grid  places  the  robot  outside  the  grid  coordinates. 
Obviously,  this  can  not  happen. 

The  second  feature  involves  the  reactions  to  various 
combinations  of  data.  If  all  three  remote  sites  are 
detected  (all  time-out  flags  unset)  ,  the  program  solves  the 
intersection  for  two  pairs  of  range-arcs  and  compares  these 
solutions  to  find  the  correct  position.  As  stated 
previously,  the  worst  case  solution  for  any  pair  cf 
range-arcs  is  two  solutions  with  all  positive  coordinates. 
This  causes  an  ambiguity.  The  second  pair  merely  resolves 
the  ambiguity. 

When  only  two  range-arcs  are  detected,  the  program 
computes  their  intersection  and  resolves  any  ambiguities  by 
comparing  the  positions  with  the  best  estimate  of  the 
current  position.  The  robot  accepts  the  solution  closest  to 
its  estimate  of  position.  This  is  a  reasonable  assumption 
since  the  basic  concept  identifies  a  need  for  the  robot  to 
update  its  best  estimate  of  position  with  this  system. 

The  third  feature  consists  of  the  cases  where  only  one 
or  no  ultrasonic  signals  are  detected.  In  the  former  case, 
the  program  prints  an  error  message  and  the  available  data. 
In  the  latter  case,  the  program  prints  only  an  error 
message.  In  an  actual  implementation,  the  navigation 
package  should  continue  to  guide  the  robot  by  dead-reckoning 
(DR)  while  the  remote  sites  are  polled  again.  This  is  true 
in  both  cases. 

The  final  feature  also  concerns  erroneous  data.  PL/I 
provides  error  routines  which  assist  the  microprocessor  in 
recovering  from  calculation  errors  such  as  taking  the  square 
root  of  a  negative  number.  When  this  occurs,  the  data  is 
bad  from  one  or  more  remote  sites  but  no  time-out  flags  are 


set.  In  this  program,  the  system  returns  to  the  CP/M 
operating  system.  In  an  actual  implementation  the  system 
should  repeat  the  polling  process  in  the  same  manner  as  when 
there  is  one  or  no  receptions  of  the  ultrasonic  signal. 
Again,  the  dead- reckoning  duties  continue. 

In  summation,  each  of  these  features  attempts  to  counter 
a  set  of  less  than  optimum  conditions.  In  the  event  these 
conditions  occur,  the  robot  continues  to  DR  itself  which  is 
the  current  convention  or  at  worst,  the  robot  can  halt  its 
motion  until  a  good  set  of  data  is  obtained.  Looping 
through  the  remote  keying  segment  of  the  program  provides 
successive  attempts  to  relocate  the  robot  and  eliminate  the 
problem.  With  this  being  the  case,  recognizing  an  error 
becomes  the  major  worry  and  not  so  much  what  the  error  is. 

Finally,  the  passing  of  parameters  between  the  PL/I  and 
the  assembly  language  modules  needs  further  discussion.  Ihe 
discussion  of  this  subject  in  [Ref.  8]  is  not  adequate. 
Basically,  whenever  a  PL/I  routine  calls  an  assembly 
language  subroutine  or  function  and  passes  the  module  a 
parameter,  the  PL/I  program  leaves  an  address  in  the  HL 
register  pair.  The  program  fellows  the  normal  addressing 
scheme  with  L  containing  the  lower  byte  of  the  address. 
This  address  points  to  the  first  entry  in  an  array  which 
contains  the  addresses  of  each  of  the  parameters  which  are 
being  passed.  Again,  the  normal  address  convention  prevails 
as  the  low  order  byte  is  stored  first.  This  second  address 
is  the  physical  address  which  is  assigned  to  the  variable 
for  the  duration  of  the  program.  Any  program  which  accesses 
this  variable  must  use  this  address.  As  a  result,  all 
assembly  language  programs  which  return  data  to  a  PL/I 
program  simply  place  the  data  at  the  physical  address  and 
return  control  to  the  PL/I  program.  The  PL/I  program  has 
conventions  for  remembering  the  addresses  of  the  variables. 
Figure  4.2  contains  an  example.  [Ref.  8] 
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HL  register  upon  entry  into 
assembly  language  program 
{pointer  to  address  list) 

Data  at  address  2000H  2000H  00H 

(address  of  variable  1)  2001II  50H 

Variable  1  location  (1  byte)  5000K  xxH 

Variable  1  location  (2  bytes)  500GH  xxH 

(low  order  byte  at  5COOH)  5001H  xxH 

The  assembly  language  program  places  data  at  addresses 
5000H  (1  byte)  or  5000H  and  500  1H  (2  bytes)  to  return 
data  to  the  ?L/I  program.  No  other  conventions  are 
required. 

If  a  second  variable  is  passed.  HL  plus  two  contains 
the  address. 

HL  after  two  increments  L  02H 

H  20H 

Data  at  address  2002  20Q2H  FFH 

2003H  50  H 

Varible  2  location  (1  byte)  50FFH  xxH 

Figure  4.2  PL/I  -  Assembly  language  Parameter  Passing 

One  additional  word  of  caution  is  necessary.  The  actual 
definition  of  the  variable  (eg.,  6-bit  integer,  15-bit  real 
number)  determines  how  many  bytes  are  required  to  represent 
a  variable.  For  example,  a  fifteen  bit  real  number  requires 
two  bytes.  Each  byte  is  addressable.  When  a  PL/I  program 
passes  such  a  variable,  the  program  passes  only  the  address 
of  the  lowest  order  byte.  Sithin  an  assembly  language 
program,  each  access  of  a  twc-byte  variable  requires  the 
manipulation  of  two  addresses. 

Discussions  about  the  program  timing  and  system 
feasibility  follow  in  the  next  chapter  with  the  results  of 
the  testing  phase. 
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Although  the  implementation  was  not  optimum,  the  system 
works  to  within  an  accuracy  of  +/-  one  foot.  Figure  5. 1 
contains  a  diagram  of  the  rocm  in  which  the  test  were 
conducted.  Table  II  and  III  contain  eight  sample  points 
with  three  successive  attempts  at  each  coordinate.  The 
tables  list  the  respective  ranges  to  each  site  and  the 
coordinate  solutions.  For  example,  position  one  in  Table  II 
contains  four  entries  with  five  elements  in  each  entry.  The 
first  row  is  the  actual  measurements  and  coordinates  for 
position  one.  The  remaining  three  entries  are  measurements 
and  coordinates  which  were  produced  by  the  system.  The 
first  three  columns  list  the  distances  from  the  various 
transmitter  sites  to  the  test  position  while  the  remaining 
two  columns  compose  the  X-Y  coordinates.  The  worst  case 
accuracy  falls  in  position  two  with  the  X  coordinate  in 
error  by  1.1  feet.  The  average  positional  error  for  all  of 
the  positions  is  0.54  feet.  Although  an  accuracy  of  one 
foot  initially  appears  to  be  large,  the  system  is  actually 
more  than  adequate  when  one  considers  the  entire  sensor 
package  which  is  located  on  a  mobile  robot.  For  both 
intruder  and  fire  detection,  sensor  ranges  come  in  tens  of 
feet.  Therefore,  the  robot  dees  not  need  greater  accuracy 
with  which  to  report  its  findings.  The  robot's  report 
contains  more  general  data  such  as  a  room  location  or 
sector.  On  the  other  hand,  the  acr  iracy  for  production  line 
work  is  far  greater.  During  proximity  navigation,  a  finite 
grid  reference  system  fails  ty  itself  when  faced  with 
dynamic  room  designs.  The  remainder  of  this  section 
presents  the  problems  with  cures  which  were  faced  during 
this  implementation. 


TABLE  II 

Sample  Position  Coordinates 


Position  Cne 


Site  1 

Site 

2  Site  3 

X 

10 

7 

10 

10 

10.7 

7.6 

10.  2 

10.3 

10.3 

7.4 

9.7 

10.3 

10.1 

7.4 

10.  6 

10.  1 

Position  Ivo 

10.8 

11 

10.  8 

10 

9.2 

1 1.  2 

11.3  1 

8.9 

8.9 

10.7 

10. 6 

9.  1 

8.9 

11.4 

11.1 

8.9 

Position  Three 

14.6 

11.7 

7.2 

14 

15.6 

11.  9 

7.3 

14.6 

13.  6 

11.5 

6.9 

13.6 

13.0 

11.3 

7.2 

13.  1 

1  1* 
11.1 
10.6 
1  1.3 


Position  Fcur 


5.7 

6.7 

16.  5 

4 

4.8 

8.  1 

17.4 

3.8 

5.9 

6.3 

16.  6 

4.7 

5.5 

6.7 

16.4 

4.4 

*  Ideal  measurements  and  coordinates 


TABLE  111 

Sample  Position  Cooidinates  (cont'd) 


Site  1 

Site 

Position  Pive 

2  Site  3 

X 

X 

7.2 

11.7 

14.6 

6 

1  1* 

6.  8 

11.9 

14 

6.1 

1  1.3 

7.1 

11.7 

14.  2 

6.  1 

11.1 

8.2 

11.  5 

14.  6 

6.5 

10.9 

10.  1 

6 

Position  Six 

10.  1 

10 

6* 

10.1 

6.8 

10.  1 

10.6 

6.9 

10.5 

6.4 

10.  6 

9.9 

6.4 

10.3 

6.18 

1 1.  1 

9.6 

6.1 

16.5 

6.7 

Position  Seven 

5.7 

16 

3* 

16.7 

7.3 

4.9 

16.3 

4.1 

18.7 

7.  1 

5.3 

16.7 

2.  1 

16.7 

7.  1 

6.2 

16.7 

2.5 

12.2 

9.2 

Position  Eight 

8.2 

12 

9* 

11.9 

9.2 

8.6 

11.  7 

9.1 

12.  1 

8.  9 

8.1 

12 

8.8 

12.6 

9.7 

8.6 

12.  4 

8.8 

*  Ideal  measurements  a  cd  coordinates 
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Concerning  the  raaio  transmitter/receiver  pairs,  the 
problems  were  three-fold.  First,  the  power  surges  which 
occur  as  the  radio  transmitter  is  turned  on  and  off  affect 


the  ultrasonic  receivers. 


This  results  in  false  echo 


detection.  The  power  supply  to  the  radio  transmitter 
requires  separate  voltage  regulation  (LM317)  and  filtering 
capacitors  (0.1  uF)  to  eliminate  this  problem. 
Additionally,  the  radio  transmitter  board,  if  not  completely 
powered  down,  generates  erroneous  signals.  Although  these 
signals  are  not  of  the  three  reguired  waveforms,  the 
receivers  process  the  erroneous  signals  and  charge  various 
capacitors  to  unknown  levels.  This  condition  destroys  the 
reproducibility  of  the  data.  Asa  result,  the  system  design 
incorporates  the  reed  relays  to  control  the  power  switching. 

Secondly,  the  receiver's  initial  stage  is  a  Colpitts 
oscillator.  The  oscillator  directly  interfaces  with  the 
antenna  and  the  power  supply  with  no  buffering.  As  a 
result,  receivers  interfere  with  each  other  if  they  are  much 
closer  than  ten  feet  or  if  they  are  not  properly  isolated 
from  ground  loops.  Since  the  radio  link  works  at 
twenty-seven  mega-hertz,  a  .01  uF  capacitor  in  parallel  with 
a  1  uF  capacitor  provides  sufficient  filtering.  As  Douglas 
V.  Hall  states  in  [Ref.  9], 

"Every  capacitor,  because  cf  its  leads  and  internal 
construction,  has  some  series  inductance.  This  series 
inductance  together  with  the  capacitance  forms  a 
series-resonant  circuit. .. above  the  resonant  frequency 
the  net  reactance  is  inductive.  increasing  as  the 
frequency  goes  up.  Because  of  the  increasing  inductive 
reactance  above  the  resonant  freauency.  the  capacitor  is 
becoming  less  and  less  effective  at  ’shorting  out'  or 
filtering  out  high-frequency  voltage  transients. .. a 
combination  of  two  capacitors  thus  provides  filtering 
over  a  wide  range  cf  frequencies." 


Thirdly,  objects  in  proximity  of  the  antennas  disturb 
the  respective  electromagnetic  propagation  patterns.  On  an 
actual  robot,  this  constraint  forces  the  antenna  on  top  of 


the  robot  such  that  the  antenna  pattern  is  least  affected  by 
the  robot  body  itself.  Likewise,  rooms  with  large  numbers 
of  metal  objects  or  poorly  shielded  electrical  cable  alter 
these  patterns.  The  large  metal  desks  within  the  test  room 
(Figure  5.1)  caused  serious  degradation  of  the  system  when 
the  transmitter  was  within  two  and  one- half  feet.  However, 
since  the  radio  and  ultrasonic  circuits  were  not  fully 
shielded,  the  total  possible  reduction  of  these  effects  is 
not  available. 

Earlier  discussicns  treated  some  of  the  problems  of  the 
ultrasonic  devices.  In  addition  to  the  requirement  for  full 
room  coverage,  two  additional  problems  arise  from  the 
ultrasonic  circuit  board.  First,  the  Polaroid  board 
contains  a  five  milli-second  delay  between  the  time  the 
transmit  cycle  is  initiated  and  the  actual  time  of  the 
ultrasonic  transmission.  This  delay  is  also 
non-reproducible  [Ref.  5  ]•  While  this  did  not  grossly 
affect  the  system,  future  improvements  in  the  system 
accuracy  require  an  improvement  in  this  aspect.  The 
National  Semi-Conductor  LM1812  has  no  documented  delay. 
Again,  the  LM1812  appears  better  for  this  application. 
Secondly,  the  gain  control  of  the  ultrasonic  receivers  is  a 
major  key  to  the  success  of  the  system.  This  implementation 
does  not  contain  an  automatic  gain  control.  [Ref.  10]  has 
such  a  circuit  for  the  LM1812.  During  testing,  the  lack  of 
a  gain  control  necessitated  recalibration  of  the  time  delays 
whenever  the  robot  platform  moved  in  excess  of  ♦/-  three 
feet.  With  an  automatic  gain  control,  this  calibration 
should  not  be  necessary. 

Finally,  an  older  copy  of  [Ref.  10]  (1977)  contains  a 
noise  reduction  tip  for  the  LM1812  chip  which  is  not  found 
in  later  versions.  "Inductive  kicks"  cause  erroneous 
ultrasonic  detections.  A  capacitor  of  approximately  30  pF 
between  pins  three  and  four  reduces  the  bandwidth  of  the 
receiver  and  filters  out  these  unwanted  noise  detections. 
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Initially,  assumptions  did  not  include  allowances  for 
circuit  delay  or  delays  in  the  radio  link..  However,  each 
link  has  a  different  delay.  Since  each  link  bases  its 
actuation  upon  a  different  signal,  one  expects  a  different 
delay  for  each  link.  As  expected,  the  delays  increase  as 
the  pulse  code  modulation  rate  decreases.  The  delays  for 
the  3000  hertz,  500  hertz  ana  constant  carrier  are  .011, 
.071,  and  .093  seconds  respectively.  However,  these 
parameters  are  unigue  to  each  circuit!  The  program 
implements  these  corrections  via  the  constants,  DELI,  DEL2, 
and  DE13. 

In  conjunction  with  the  previous  discussions  on  the 
circuit  and  radio  link  delays,  the  major  time  constraints 
come  from  the  debouncing  features  of  the  program.  When 
three  signals  are  detected,  the  system  returns  a  solution  in 
a  total  time  of  1.5  seconds.  The  above  time  includes  one 
debouncing  call  before  keying  each  of  the  remote  sites.  The 
FAIT  program  incorporates  a  combination  of  no  signal  and  an 
arbitrary  time  delay  to  debounce  the  receivers.  With  more 
accurate  testing,  the  time  for  debouncing  is  reducible.  Of 
course,  if  one  or  more  signals  are  not  detected,  the  total 
system  time  becomes  a  function  cf  the  time-out  conditions. 

Although  each  circuit  nominally  has  small  current 
requirements,  the  short  term  reguirements  force  careful 
voltage  regulation  at  both  the  robot  and  at  the  remote 
sites.  In  addition  to  the  power  switching  of  the  radio 
transmitter,  the  remote  ultrasonic  units  also  cause  the  same 
problems.  For  the  Polaroid  devices,  the  circuit  requires 
six  volts  at  two  and  cne-half  amps  for  one  milli-second .  A 
combination  of  an  LM340T-6.0  voltage  regulator  and  a  470  uF 
capacitor  at  the  load  prevent  the  ultrasonic  circuit  from 
disturbing  the  power  supply.  Interruption  of  the  power 
supply  disturbs  both  the  radio  receiver  and  the 
comparator/interface  circuits. 
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Obviously,  the  number  one  problem  of  an  ultrasonic 
system  is  obstructions.  For  this  reason,  the  actual 
implementation  of  this  design  on  a  robot  requires  the  radio 
antenna  on  top  of  the  robot  with  the  omni-directional 

ultrasonic  receiver  section  directly  underneath.  The 
highest  obstruction  within  the  environment  determines  the 

minimum  height  at  which  the  ultrasonic  system  may  be 

located.  Since  the  program  needs  a  minimum  of  two 

unobstructed  ranges  for  a  solution,  the  line  of  sight 
between  the  robot  and  two  of  its  remote  sites  must  remain 
clear.  As  long  as  the  progran  knows  the  location  of  the 
sites  and  the  correct  distance  to  the  site,  the  coordinates 
are  obtainable.  Later  chapters  discuss  alternatives  for 
site  location  and  systems  with  more  than  three  remote  sites. 


VI.  HAEDWABZ  FOB  THE  MANIPULATOR  REFERENCE  SYSTEM 


The  differences  between  the  sentry  robots  reference 
system  and  the  manipulator’s  are  few.  However,  these  few 
changes  are  significant.  Overall,  the  design  requires  fewer 
components  and  is,  therefore,  less  complex. 

The  manipulator’s  reference  system  does  not  have  the 
need  for  total  autonomy  which  the  mobile  robot  does.  As  a 
result,  all  of  the  peripheral  sensors  directly  interface 
with  the  microprocessor .  This  eliminates  the  need  for  the 
radio  links.  Additionally,  this  eliminates  all  of  the  noise 
which  is  associated  with  radio  transmissions. 

Second,  the  microprocessor  input/output  ports  reverse 
their  importance.  In  the  sentry  design,  the  output  port 
maintains  the  proper  control  of  the  three  remote  transmitter 
sites.  The  manipulator  uses  only  one  output  to  key  a  single 
transmitter  which  is  located  on  the  arm.  The  design  again 
uses  the  Polaroid  ultrasonic  device  as  the  transmitter.  The 
interface  circuitry  consists  of  the  normal  TTL  logic  signal 
for  the  microprocessor  and  the  comparator  circuitry  in 
Figure  6.1  which  was  used  at  the  remote  sites  in  the  sentry 
design. 

The  input  ports  change  from  an  omni-directional  receiver 
input  to  three  single  multiplexed  receivers.  No  actual 
wiring  changes  occur.  However,  the  software  services  the 
input  port  differently.  The  next  chapter  further  explains 
the  changes  in  the  software.  There  is  one  addition  to  the 
input  circuitry.  The  Polaroid  devices  do  provide  access  to 
the  actual  transmitter  driving  signal.  The  signal  name  is 
”XLOG”.  This  signal  allows  the  system  to  begin  the  system 
clock  synchronously  and  also  improves  both  accuracy  and 
reproducibility  of  the  data.  Table  IV  contains  the 
input/output  port  configurations. 
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TABLE  17 

Port  Assignments  foz  the  Manipulator 


Output 


Port . Device 


Ultrasonic  transmitter 


1-7 . No  connection 


Input 


Port . Device 


Receiver  1 
Receiver  2 
Receiver  3 
XLOG  signal 
No  connection 


The  remaining  circuitry  remains  the  same  as  in  the 
sentry  design.  This  includes  the  microprocessor  workstation 
and  the  LM1812  ultrasonic  circuits.  A  three-quarter  inch 
plywood  board  provides  the  requisite  support  for  the  three 
ultrasonic  receivers. 

The  software  changes,  which  are  discussed  in  the  next 
chapter,  likewise,  are  few.  This  circuitry  provides  a 
simple  but  effective  system  with  which  a  reference  system 
may  be  established.  However,  as  will  be  discussed  later,  a 
final  design  will  require  much  more  detailed  analysis  of  the 
transceiver  design  such  that  mere  uniform  coverage  may  be 
obtained. 


VII.  SOFTWARE  FOB  THE  MANIiSiii'EOR  REFERENCE  SYSTEM 


As  stated  previously,  the  sentry  robot  software  is 
modular  in  the  hope  that  it  might  be  more  portable.  The 
manipulator  software  also  follows  this  policy.  In  fact,  the 
manipulator  software  originated  from  the  sentry  robot 
software  with  only  a  few  changes.  Figure  7.1  contains  a 
block  diagram  of  the  system  logic.  Appendix  D  contains  the 
complete  program  listings. 

The  program  has  the  same  major  sections  as  the  sentry 
robot’s  program.  After  initialization,  the  main  program 
serially  determines  the  distance  between  the  three  receivers 
and  the  transmitter  which  is  located  at  the  manipulator  tip. 
This  procedure  involves  three  calls  to  the  assembly  language 
modules  as  in  the  previous  programs.  Next,  the  program 
checks  for  proper  reception  of  data.  If  the  data  is  bad, 
the  program  terminates  with  an  error  message.  If  the  data 
is  good,  the  program  first  calculates  the  line-of- sight 
departure  angle  and  then  the  corresponding  axis  coordinate. 
Lastly,  the  program  prints  the  appropriate  data  onto  the 
CRT. 

Obviously,  the  calculations  which  are  made  in  the 
manipulator  program  are  different  from  those  of  the  sentry 
program.  However,  the  debouncing  and  time/distance 
conversion  modules  are  unchanged.  The  ''ANGLE"  and  "CCORD" 
modules  replace  the  "P0SIT3"  and  P0SIT2"  modules.  By 
comparing  the  two  PL/I  programs,  their  similarity  becomes 
apparent. 

Just  as  expected,  the  main  changes  in  the  programming 
occurred  in  the  assembly  language  modules.  While  the 
parameter  passing  remained  unchanged,  both  the  clock  and  the 
receiver  polling  are  different.  To  obtain  a  more  accurate 


Variable  And 
program 

Initialization 


Remote  Device 
Keying 


Is  Data' 
Good  y 


Stop 


Figure  7.1  Flow  Diagram  of  the  Hanipulator  System  Logic 

clock,  the  program  implements  a  software  clock.  A  software 
clock  uses  a  specific  loop  with  a  known  execution  time  to 
increment  a  count  of  the  real  time.  In  this  case,  the  loop 
increments  in  .00005  second  intervals.  Within  the  loop,  the 
program  polls  the  input  port  fcr  the  appropriate  reception 
of  the  ultrasonic  signal.  The  transmitter  code  of  the 
sentry  robot  program  becomes  a  receiver  code  in  this  system. 


During  the  polling  process,  the  microprocessor  "AND's"  the 
cole  with  the  input  from  the  pert.  Table  V  contains  these 
codes.  The  program  tests  for  proper  signal  reception  by 
checking  the  various  flags  which  are  set  by  the  "AND-ing" 
operation.  Upon  signal  reception  or  time-out,  the  program 
returns  control  and  data  to  the  PL/I  main  program. 


TABLE  V 

Receiver  Control  Codes 


0001  .  Receiver  1  reception* 

0010 . .  Receiver  2  reception 

0100 . .  Receiver  3  reception 

1000  . XLQ3  signal  reception 


*  (The  most  significant  bit  is  the  left  position.) 

Since  both  the  receivers  and  transmitter  are  directly 
interfaced  to  the  microprocessor,  reduced  delays  and  more 
positive  control  are  possible.  Also,  the  XLOG  signal  which 
drives  the  ultrasonic  transmitter  interfaces  with  the 
microprocessor  and  initiates  the  software  clock  loop. 

finally,  while  this  system  encompasses  fewer 
alternatives  (no  degraded  modes) ,  the  system  still  must 
recover  gracefully  whenever  no  solution  is  possible.  If  any 
of  the  time-out  flags  are  set,  the  system  prints  an  error 
message.  Also,  if  the  data  does  not  provide  a  solution 
(eg.,  the  program  attempts  to  take  the  sguare-root  of  a 
negative  number) ,  the  PL/I  error  routines  print  the  error 
messages.  In  an  actual  implementation,  the  program  should 
simply  loop  for  another  attempt.  Currently,  the  loop  takes 
less  than  one  second.  These  problems  are  further  discussed 
in  the  test  results  which  follow. 
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VIII.  MAHIPOLATOE  COO SPIN ATE  SYSTEM  TEST  RESULTS 


■With  the  elimination  of  the  radio  circuits/  the  accuracy 
and  consistency  of  the  distance  measurements  improve 
tremendously.  When  the  transmitter  is  stationary  and 
successive  measurements  are  taken,  the  differences  occur  in 
the  hundredths  of  a  fcot.  The  overall  positional  accuracy 
of  the  system  increases  to  the  tenths  of  a  foot.  Table  VI 
and  VII  contain  a  listing  of  sample  position  data.  The 
tables  list  the  respective  ranges  to  each  sensor  and  the 
coordinate  solutions.  For  example,  position  one  in  Table  VI 
contains  four  entries  with  six  elements  in  each  entry.  The 
first  row  is  the  actual  measurements  and  coordinates  for 
position  one.  The  remaining  three  entries  are  measurements 
and  coordinates  which  were  produced  by  the  system.  The 
first  three  columns  list  the  distances  from  the  transmitter 
to  the  respective  receivers  while  the  remaining  three 
columns  compose  the  X-Y-Z  coordinates.  The  worst  case 
accuracy  falls  in  position  seven  with  the  Y  coordinate  in 
error  by  0.32  feet.  The  average  positional  error  for  all  of 
the  positions  is  0.30  feet. 

Even  with  this  improvement  in  accuracy,  the  accuracy  is 
not  good  enough  for  truly  intricate  assembly  maneuvers. 
This  is  due  inpart  to  the  lack  cf  an  automatic  gain  control. 
Whenever  a  significant  change  in  the  transmitter  position  or 
orientation  occurs,  the  time  response  of  the  ultrasonic 
receiver  changes  as  previously  discussed  in  the  test  results 
on  the  sentry  robot  reference  system.  Secondly,  further 
research  is  necessary  to  fully  calibrate  such  a  system. 
This  calibration  includes  the  definition  of  a  reference 
point  on  the  transducer  fron  which  the  distances  are 
measured.  Additionally,  the  introduction  of 


more 


coverage  adds  to  the 


transducers  for  an  increase  in 
calibration  problems. 

This  design,  however,  prones  the  feasibility  of  such  a 
system.  By  constraining  the  sensors  to  one  plane,  the 
manipulator  enjoys  a  full  range  of  unobstructed  motion.  The 
designer  places  the  reference  system  wherever  the  location 
is  most  convenient.  This  includes  floors,  ceilings,  walls 
or  in  the  face  of  the  manipulator  base.  Thus,  the  reference 
system  may  be  absolute  when  it  is  stationary  or  relative 
when  it  is  rotated  on  the  base. 

The  system  loop  takes  less  than  one  second  to  complete. 
Again,  the  debouncing  routine  causes  the  longest  delay.  A 
reduction  in  this  delay  will  optimize  the  system  response 
since  the  WAIT  routine  is  called  three  times.  This  design 
does  not  minimize  this  delay.  Additionally,  the  delays  for 
the  three  receivers  are  .023,  .019,  and  .022  seconds  for 
receivers  one,  two,  and  three  respectively.  These  delays 
are  also  much  less  than  the  sentry  robot  design  because  they 
do  not  include  the  radio  link  delay  with  its  pulse  code 
modulation. 

Most  of  the  improvement  in  consistency  of  the  data  is 
attributable  to  the  usage  of  the  XLOG  signal  from  the 
ultrasonic  circuit  beard.  This  signal  eliminates  the  need 
to  estimate  the  five  milli-second  delay  between  the 
activation  of  VSW,  the  keyjng  signal,  and  the  actual 
transmission.  Instead,  the  deck  begins  its  count  when  the 
actual  transmission  signal  originates.  The  LM1312  has  no 
such  comparable  signal  unless  the  transmission  signal  to  the 
transducer  head  is  used. 

The  system  concept  is  feasible.  With  the  gain  control 
and  further  calibration,  the  desired  system  accuracy  should 
be  obtainable. 


TABLE  71 

Saaple  Position  Coordinates  (Manipulator) 


Position  Cne 


Site  1 

Site  2 

Site  3 

X 

Y 

2 

.833 

.666 

.750 

.5 

.833 

.833* 

.  834 

.666 

.750 

.65 

.75 

.80 

.834 

.723 

.750 

.69 

.69 

.81 

.834 

.666 

.750 

.65 

.75 

.81 

Position 

Ivo 

.567 

.636 

.756 

.5 

.5 

.  29* 

.436 

.55 

.86 

.32 

.39 

.21 

.  436 

.55 

.86 

.32 

.39 

.21 

.437 

.55 

.86 

.32 

.39 

.21 

Position 

Thxee 

.52 

.726 

.527 

.5 

.333 

.666* 

.  266 

.836 

.41 

.25 

.23 

.5 

.266 

.893 

.41 

.25 

.21 

.5 

.266 

.836 

.419 

.25 

.23 

.5 

Position 

Pour 

1.  16 

1.05 

1.12 

1.0 

.833 

.833* 

1.16 

1. 05 

1.07 

.33 

.92 

1.07 

1.  16 

1.05 

1.12 

.94 

.915 

.85 

1.  16 

1.04 

1.07 

.83 

.915 

1.07 

Position 

live 

1.03 

1.  07 

1.  15 

1.0 

.5 

.3* 

00 

CO 

• 

.99 

1.06 

.81 

.36 

.  17 

00 

00 

• 

.94 

1.07 

.80 

.46 

.  17 

.87 

.935 

1.07 

.80 

.46 

.  17 

*  Ideal  measurements  and  coordinates 
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TABLE  VII 

Sample  Positions  {Manipulator  cont'd) 

Position  Six 


Site  1 

Site  2 

Site  3 

X 

Y 

Z 

1.03 

1.16 

1.0 

1.0 

.33 

.83* 

1.  13 

1.34 

1.  10 

1.04 

.12 

.80 

1.02 

1.29 

.932 

.  841 

.05 

.92 

1.13 

1.34 

1.  10 

1.04 

.01 

.80 

Position 

Seven 

1.0 

1.  11 

1.04 

1.0 

.33 

.5* 

1.01 

1.15 

1.04 

1.01 

.29 

.61 

1.01 

.98 

1.  10 

.96 

.65 

.42 

.91 

1.  10 

.92 

.89 

.21 

.60 

Position 

Eight 

1.16 

1.12 

1.05 

1.0 

.83 

.83* 

1.  13 

1.  0 

1.01 

.75 

.92 

1.  1 

1.13 

1.0 

1.07 

.88 

.92 

.89 

1.07 

.89 

1.01 

.767 

.99 

.86 

Position  Sine 

1.06 

1.08 

1.0 

1.0 

.79 

.  54* 

1.11 

1.  12 

1.04 

1.0 

.56 

.89 

.99 

1.  01 

.932 

.91 

.54 

.83 

.99 

.95 

1.  10 

.94 

.79 

.49 

Position  7en 

1  . 19 

1.  12 

1.37 

1.0 

.75 

0.0* 

1.27 

1.  18 

1.38 

1.1 

.94 

.15 

1.3 

1.24 

1.5 

.91 

.98 

-.22 

1. 33 

1.29 

1.5 

1.02 

.79 

-.20 

*  Ideal  measurements  and  coordinates 


IX.  CONCLUSIONS 


The  position  control  loop  in  robotics  no  longer  needs  to 
be  a  semi-closed  loop.  With  an  ultrasonic  reference  system 
in  place,  positive  control  of  a  mobile  platform  or 
manipulator  is  possible.  Alsc,  a  reference  system  limits 
the  cumulative  error  since  it  becomes  a  function  of  the 
coordinate  system's  recursive  cycle.  Armed  with  this 
information,  a  controller  can  implement  more  sophisticated 
guidance  packages  without  complicated  error-correcting 
software. 

The  cost  of  such  a  system  is  not  prohibitive.  The  cost 
of  the  major  components  keep  the  total  system  hardware  cost 
well  below  $250.00.  Even  with  more  dedicated  designs,  the 
system  cost,  when  mass-produced  to  lower  the  cost  further, 
makes  the  reference  system  an  expendable  commodity.  As  a 
matter  of  fact,  a  single  printed  circuit  board  design  is 
easily  conceivable  which  would  permit  the  maintenance 
operator  to  simply  remove  and  replace  the  entire  system. 

Since  the  device  need  not  be  powered  continuously,  the 
system  is  a  low  power  consumer.  This  is  a  mandatory 
requirement  for  an  autonomous  robot.  Even  the  Polaroid 
device  with  its  two  and  one-half  ampere  current  requirement, 
operates  successfully  on  batteries.  Polaroid  uses  the 
Polapulse  battery  for  power  in  its  test  and  evaluation  kits 
[Bef.  5].  Therefore,  the  power  considerations  are  minimal. 

While  the  two  systems  failed  to  achieve  the  desired 
increase  in  accuracy,  closer  cooperation  with  the 
manufacturers  and  additional  research  surely  can  improve  the 
system  accuracy.  The  chapter  on  recommendations  includes 
hints  by  which  the  accuracy  of  the  systems  may  be  improved. 
Most  importantly  though,  any  implementation  of  these 


ultrasonic  devices  dictates  the  use  of  an  automatic  gain 
control.  Unfortunately,  this  research  only  identified  this 
problem  and  the  cure.  Neither  design  contains  this  control. 

Of  course,  the  number  one  enemy  of  an  ultrasonic  system 
is  obstructions.  If  the  signal  can  not  reach  the  receiver 
via  its  line  of  sight,  the  system  does  not  work.  Therefore, 
within  reason,  the  concept  requires  sufficient  reference 
transmitters/receivers  to  provide  one-hundred  percent 
coverage.  As  the  number  of  transmitter/receiver  sites 
increases,  the  complexity  of  the  encoding  schemes  which 
control  these  sites  increases.  The  sentry  system  requires 
at  least  two  ranges  at  all  times  while  the  manipulator 
requires  at  least  three.  The  environmental  geometry 
dictates  the  actual  number  required. 

Although  the  use  of  PL/I  was  expected  to  hamper  the 
system  speed,  this  was  clearly  not  the  case.  The  main  time 
delay  of  either  system  is  the  various  debouncing  routines, 
the  signal  propagation,  and  the  time  delay  of  the  external 
circuitry.  Accordingly,  the  use  of  a  faster  (greater  than 
two  mega-hertz)  or  larger  (greater  than  8  bits) 
microprocessor  will  not  provide  a  corresponding  payoff  in 
throughput.  Until  the  other  delays  are  reduced,  the 
emphasis  of  future  designs  should  focus  upon  optimizing 
these  circuits  and  components. 

As  stated  earlier,  the  Polaroid  ultrasonic  unit  is  an 
excellent  device  for  ranging.  The  unit  is  easy  to 
incorporate  into  designs  and  is  extremely  reliable. 
However,  in  this  design,  it  fails  to  provide  sufficient 
receive-only  capability  and  beam  width.  The  Panasonic 
EFR-OTE40K2  transducer  when  incorporated  with  the  LH1812 
provides  far  better  results,  even  though  the  LM1812  requires 
far  more  circuitry. 

Finally,  this  thesis  cannot  over  emphasize  the  necessity 
of  following  good  "breadboard  techniques".  Although  the 
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following  list  may  see m  obvious,  the  number  of  hours  spent 
trouble  shooting  problems  associated  with  the  list  was 
large. 

1.  Regulate  all  power  supplies. 

2.  Use  filtering  capacitors  liberally.  Remember,  it 
may  require  two  in  parallel  to  fully  cover  the 
requisite  bandwidth. 

3.  Use  heatsinks  on  all  regulators. 

4.  Use  only  good  breadboards  or  wire-wrap. 

5.  Follow  good  solder  techniques. 

6.  Use  coaxial  cable  wher  possible,  especially  when 
the  distance  is  over  six  inches. 

7.  Do  not  underestimate  the  power  of  proper  shielding. 

8.  Elan  your  layout  carefully. 

9.  Color  code  your  wiring. 

10.  Divide  and  conquer  or  segment  and  test. 

Ultrasonic  reference  systems  are  realizable  and 

feasible.  This  thesis  reflects  this.  The  future  of 
robotics  should  no  longer  contain  open  loop  designs.  The 
reference  systems  can  be  inexpensive,  accurate  and  low 
power.  Closed  loop  control  is  possible. 
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X.  RECOMMENDATIONS 


Both  the  sentry  and  manipulator  reference  system  designs 
provide  a  means  by  which  the  position  control  loop  can  be 
closed.  As  stated  in  LCDR  Everett’s  thesis  and  numerous 
other  texts  and  reference,  separate  microprocessors  should 
implement  these  functions  in  parallel  with  the  master 
microprocessor.  However,  the  designs  need  further  research 
and  development. 

Foremost  in  the  sentry  design  is  the  need  of  a  more 
consistent  radio  link.  The  problems  which  were  attributed 
to  the  Cclpitts  oscillator  can  be  eliminated  with  a  better 
design  and  a  change  in  operating  frequency.  Of  course,  a 
final  implementation  requires  greater  attention  to  circuit 
and  cable  shielding.  Antenna  placement  is  also  important. 

Second,  the  integration  of  the  transducer  into  a 
functioning  system  while  obtaining  the  necessary  coverage  is 
important.  Unless  an  omni-directional  transducer  is 
available,  any  design  will  require  multiple  transducers 
working  in  parallel  both  at  the  transmitter  and  receiver 
locations.  While  this  may  be  less  of  a  problem  in  the 
sentry  design,  the  manipulator,  with  its  infinite 
orientations,  is  a  most  difficult  problem.  These 
applications  might  require  an  original  transducer  design. 

Transducer  sensitivity  is  controllable  through  external 
circuitry  on  the  LM1812.  Since  the  Polaroid  device  provides 
excellent  control  of  the  sensitivity  out  to  a  range  of 
thirty-five  feet  (seventy  feet  including  the  return  path)  , 
the  range  of  current  devices  is  more  than  adequate  for  the 
manipulator  and  the  sentry  robot  for  indoor  uses.  Any 
implementation  which  uses  ultrasonics  needs  this  sensitivity 
control,  especially  when  the  operating  distances  are  in 


close  proximity.  Without  the  automatic  gain  control,  the 
time  delays  are  variable  and  dependent  upon  the  distance  or 
signal  strength  which  is  unknown.  Further,  no  device 
currently  employs  gain  control  on  the  transmitter.  In  a 
closed  loop  and  close  proximity  system  such  as  these,  the 
transmitter  gain  control  might  use  the  estimated  position  as 
as  reference  by  which  the  gain  is  varied.  This  permits  the 
usage  of  constant  gain  receivers  in  a  multiple  receiver 
syst  em. 

Although  the  velocity  of  sound  is  not  critically 
dependent  upon  temperature,  it  is  none  the  less  a  function 
of  temperature.  The  LM3911  easily  provides  temperature 
sensing  which  may  be  directed  to  the  navigation 
microprocessor.  With  the  correct  ambient  temperature,  the 
microprocessor  updates  the  speed  of  sound  with  which  the 
time/distance  conversions  are  made.  A  change  from 
sixty-eight  to  sixty-nine  degrees  Fahrenheit  translates  to 
an  additional  one  foot  per  second  in  velocity. 

Although  the  basic  calculations  will  not  change,  the 
error  handling  within  each  software  package  is  unigue  to 
each  application.  While  looping  successively  through  the 
program  is  an  obvious  choice  to  correct  a  fault,  the 
designer  faces  more  important  guestions.  Should  movement 
continue?  How  fast  can  actions  continue?  How  large  are  the 
tolerances?  The  designer’s  considerations  include  the 
machine  and  the  environment.  Finally,  redundancy  improves 
reliability  and  accuracy  but  it  increases  cost  and 
complexity . 

Even  though  the  accuracy  of  the  robot  sentry  and 
manipulator  designs  does  not  improve  upon  the  current 
accuracies  of  systems  without  such  references,  the 
theoretical  limits  of  accuracy  which  are  a  function  of 
frequency  are  far  better  than  current  systems  provide.  For 
example,  at  fifty  kilo-hertz,  the  wavelength  is  .272  inches 


machine  and  the  environment, 


accuracy  but  it  increases 


cost  an  u 


or  .69  centimeters.  At  200  kilo-hertz,  the  wavelength  is 
.068  inches  or  .173  centimeters.  Since  the  signal  detection 
depends  upon  the  rising  edge  of  the  incoming  signal, 
accuracies  of  this  magnitude  are  possible.  Any  delays  are 
of  no  consecuence  as  long  as  the  aelais  are  consistent. 

With  the  final  design  perfected,  the  desired  positive 
control  is  possible.  Martin  Weinstein  in  [Ref.  2]  gives  a 
very  detailed  description  of  a  memory  map  with  which 
navigation  planning  and  obstacle  avoidance  might  be 
performed.  However,  two  additional  items  should  be 
considered.  First,  any  navigation  scheme  needs  an  endpoint 
or  goal.  Second,  the  memory  map  needs  to  incorporate  visit 
time  within  its  structure.  The  goal  in  a  sentry's 
reconnaissance  is  one  hundred  percent  coverage  of  the 
security  area  in  a  timely  manner.  Therefore,  the  interim 
goal  becomes  one  of  visiting  the  block  with  tne  oldest  visit 
time.  once  the  goal  is  determined,  the  navigation  unit 
decides  the  optimum  path.  As  the  robot  transverses  the 
chosen  path,  the  navigation  microprocessor  updates  the  visit 
times  of  the  blocks  which  are  crossed  plus  ALL  BLOCKS  VJiilCH 
FALL  INTO  THE  SECURITY  OR  FIRE  DETECTION  RANGE  OF  THE 
ROBOT'S  SENSORS!  This  scheme  allows  the  sentry  to  provide 
one-hundred  percent  coverage  since  a  block  which  is  not 
visited  will  eventually  become  an  interim  goal  as  its  visit 
time  grows  to  exceed  all  others.  Weighting  factors  which 
are  associated  with  high  risk  areas  improve  the  revisit 
times  to  these  areas. 

LCDR  Everett  mentions  path  planning  routines  such  as  the 
computer  game  "Othello”.  Also,  in  [Ref.  11],  four  papers 
addressed  this  issue.  They  are  listed  in  the  bibliography. 
However,  the  work  by  Keirsey  et  al.  at  the  University  of 
Florida  and  at  Hughes  Research  Laboratories  looks  very 
promising.  In  their  paper  [Ref.  12],  this  group 
substantiates  their  work  in  tactical  navigation.  More 
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specifically,  their  work  includes  search  graph  construction 
and  heuristic  searches  for  path  planning. 

The  Zenith  Corporation  currently  markets  an  ET-18  Robot 
Remote  Control  Unit  which  provides  remote  control  for  the 


HERO  Robot. 


The  remote  control  unit  also  interfaces  with 


microprocessors  through  the  RS-232  loop.  This  system  is  a 
potential  testbed  for  both  the  reference  system  and  various 
robot  control  algorithms.  Currently,  robots,  like  the  HERO, 
do  not  keep  track  of  their  positions  nor  do  they  have 
sufficient  memory  onboard  to  store  the  programs  for  such 
research.  This  experimental  set-up  provides  both  control 
and  virtually  unlimited  memory  while  the  cost  and 
complexity  of  the  robot  is  held  to  a  minimum.  With  this 
arrangement,  the  ultrasonic  transmitter  and  receivers  should 
exchange  places  for  the  best  results  and  ease  of 
implementation.  Consequently,  the  remote  receivers 
interface  to  the  microprocessor  via  hard-wired  connections. 
Also,  the  microprocessor  keys  the  ultrasonic  transmitter  on 
the  robot  through  the  radio  remote  control. 

The  literature  on  manipulator  control  is  far  more 
abundant.  However,  no  model  completely  closes  the  position 
control  loop.  At  best,  the  controllers  deal  only  with  the 
motors  and  the  motor  feedback.  The  systems  do  not  directly 
measure  the  errors  which  were  discussed  previously.  These 
systems  rely  upon  error  models  or  no  models  at  all. 

While  the  three  dimensional  system  herein  does  locate 
the  tip  of  the  manipulator,  the  system  fails  to  identify  the 
orientation  of  the  gripper  cr  the  rotating  base.  A 
manipulator  with  six  degrees  cf  freedom  needs  additional 
reference  data  to  fully  orient  the  system.  A  possible 
solution  consists  of  optical  calibration  lines  which  can  be 
accurately  located  and  read  on  the  manipulator.  The  optical 
sensors  and  cable  are  small  and  light.  They  will  not  place 
any  further  weight  restrictions  upon  the  arm.  Also, 


today's  optical  components  interface  directly  onto  printed 
circuit  boards  and  integrated  circuits.  These  advantages 
support  this  approach  very  strongly. 

The  three  dimensional  reference  system  provides  3ata 
from  which  position  and  velocity  information  may  be 
determined.  While  this  information  is  in  cartesian 
coordinates,  the  conversion  to  other  coordinate  systems  is 
available  and  well  documented.  Microproce ssors  handle  these 
conversions  nicely.  As  a  result,  the  myriad  of  manipulator 
control  schemes  have  a  better  testbed  upon  which  they  can  be 
tested.  More  importantly,  the  manipulator  will  no  longer 
require  the  teaching  cycles  whicn  currently  program 
industrial  robots.  Instead,  the  potential  is  present  for 
the  manipulator,  when  it  is  given  tne  various  coordinates, 
to  determine  both  the  commands  and  the  routing  for  each 
task.  Much  of  today's  robotic  research  deals  with 
high-level  hierarchical  languages  for  robotic  control.  With 
these  languages,  more  general  commands  such  as  "pick  up 
block"  release  the  programmer  from  the  tedious  task  of 
providing  the  exact  commands  for  all  ox  the  motors  involved 
in  the  motion. 

In  summary,  with  the  positicn  loop  finally  closed  in  the 
robotics  field,  more  positive  control  is  obtainable.  An 
ultrasonic  system  will  not  handle  every  environment. 
However,  with  additional  research,  the  environments  for 
which  ultrasonics  are  suitable  will  be  identified.  The  goal 
of  increased  accuracy  will  become  a  reality. 


APPEND II  k 

DERIVATION  OP  SENTRY  EOSITION  EQUATIONS 

This  derivation  is  a  general  solution  for  an 
intersection  of  two  range  arcs  which  are  associated  with  two 
different  reference  points. 

Coordinate  definitions: 

X  =  XAOF  ♦/-  XA  =  XBOF  */-  X3  where  OF  are  the  offsets  of 

Y  =  YAOF  +/-  YA  =  YBOF  +/-  YB  the  reference  points  from  the 

origin  and  X_  or  Y_  is  the 
respective  distances  to  the 
position  from  the  reference 
points  in  vector  notation. 

Range  arc  definitions: 

AR**2  =  XA**2  +  YA**  2  where  _r  is  the  radius  of  the 

BE** 2  =  XB**2  ♦  YB** 2  arc 

Equate  X's 

XAOF  ♦/-  XA  =  XBOF  +/-  X3 

Solve  the  range  arc  equations  for  the  vector  magnitude  X_ 
and  substitute  into  the  above  equation 

XAOF  +/-  (AR**2  -  YA  **2)  **.5  =  XBOF  +/-  (3R**2  -  YB**2)**.5 
Rearranging 

+/-  (AR**2  -  YA**2)  **.5  =  XBOF  -  XAOF  +/-  (BR**2  -  Y3**2)**.5 

Define  DIF  =  X30F  -  XAOF  and  square  both  sides  of  the  equation 

AP.  *  *  2  -  Y  A  *  *  2  =  DIF*  *2  ♦/-  (2*DIF*  (3P.**2  -  Y3**2)**.5)  +  BR**2 
-Y5*  *2 
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Solve  for  +/-  (2  *DIF*  (BR**2  -  YE**2)**.5)  and  square  both 
sides  of  the  equation  again 

4*(DIF**2*(3E**2  -  YB**2))  =  AR**4  +  YA**4  +  Y3**4  +  BR**4 
♦  DI F**4  +  2* (-AR**2*YA**2  +  AE  **2*Y B** 2  -  Y3**2*DIF**2 
-  YA**2*YB**2  -  AR**2*BR**2  +  YA**2*BE**2  -  AR**2*DIF**2 
+  YA**2  *DIF**2  -  YB**2*BR**2  +  ER**2*DIF**  2) 

Substituting  for  YA  and  YE,  and  expanding  the  terms  yields 
the  quadratic  equation  which  was  discussed  in  chapter  2 
(egn  2.2) 

C0EFl*Y**2  +  C0EF2* Y  +  C0EF3  =  C 
where 

C0EF1  =  4*  (YA0F**2  +  YB0F**2  -  2*  YAOF*YBOF  +  DIF**2) 

C0EF2  =  4*  (AR**2*YA0F  -  YA0F**3  -  YB0F**3  -  AR**2*YBCF 
+  Y AOF * Y BO F* * 2  +  YA0F**2*Y30F  -  BR**2*YAOF 

-  DIF**2*YACF  +  BR**2*  YEOF  -  DIF**2*Y30F) 

C0EF3  =  AR**4  +  BR**4  4  DIF**4  4  YA0F**4  4  YBO?**4 

4  2*  (AR**2*YECF**2  -  Afi**2*YA0F**2  -  YA0F**2*Y30F**2 

-  AR**2*3R**2  4  3R**2*YAOF**2  -  AR**2*DIF**2 

4  DIF**2*YAOF**2  -  BR**2*Y30F**2  *  DIF** 2* YBOF* *2 

-  BR**2 *DIF* *2) 


NAVROB: 

FROC  OPTIONS  (MAIN); 

/H' ILL  I  AM  M.  DUNKIN,  LT  ,  USN  WROTE  THIS  PROGRAM  AS  Tu7  SOFTV'ARF*  / 
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PS 


SENTRY  ROBOT  REFERENCE  SYSTEM  SOFTWARE 
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;fop  an  autonomous  sentry  robot,  this  PROCEDURE  INITIALIZES 
;  THE  CLOCK  TO  COUNT  PROPAGATION  TIME  OF  THE  ULTRASONIC  SIGNAL. 
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